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(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a walking 
attitude producing device for a leg type mobile robot, in 
particular a two-foot walking robot, with which it is 
practicable to produce any desired walking attitude to 
enable continuous walking for a long period. 
SOLUTION: Two walking attitudes are produced for one 
step, and if there is any discontinuous quantity at their 
boundary such as the position and/or speed of the 
upper body of robot, or ZMP(zero moment point), the 
input obtained on the basis of the inverse number of the 
discontinuous quantity is given to a perturbational 
dynamic model so as to cancel the discontinuous 
quantity, and the produced walking attitude is corrected 
with the output, and a walking attitude is accomplished 
which has a continuous robot upper body position 
and/or speed or ZMP even at the boundary. 
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Vs. -t^ZMP^KlSD s <ht^ 0 
[0069]^ ^^l/ZMP^«iS«ZMP^ai^S 

f*WKtt. ®2^©^j^ffigg#flig£*£g© 

WHiiWfiigitoM-c*^., iis-rs£ > c©m 
so *Jor*titf. tB^S®ZMPt*jt*|{ci5cSJ:^K*fe 



11 

W&M®M&&M.~§rz>b, c©i£#so-c«!5:<&«j, m 

[0070] cti^^y^mitrnwrn^t, ,x<d£$ 

Xs = -Xm 
V s = -Vm 
D s = - Dm 

[00 7 1 ] CCX\ H7«c^-rj:9K» «SdR^-K# 

©iS£& r^t^r^j t 3&i*N?©-en& rm 

l^SZMP;^7^B 1 J l£2^©-€-ft£ T^2# 
§ZMPa*-^7XB 2 J £(,>5„ ;t-f7XBl. B2 
«, J: i 9**^{cttSli^fcj:y>'||2^'C©ZMP 

©€fitwsc8a«*^-r. h> e©93«wctiai • aut 

[0072]^ *f*;UZMP©ffi«^M*«. 3tf$» 

J^»©H**s»& & „ -=e f\>u z M P *m l ^©ffi *§ 

i^u sm#;g©ffi*B 
^»E>Sfc0i ^^s^e^Ji-ZMPBor*^^ id 
2 ^(ommm* h mem 2 ^©sjjk* r>v zmp 

«, 07(C^-r^P<. -DsiftS, — 

£, ogStK&S^&flJJWZMPtfS, 

©EWBR* t*;U Z MP fcjto*. 5 C t ic J: 0 » 6 

ft3SI2^;g©*fl»3ZMP«, -3S5t*f)-Ds-D 
m ( = 0) ©&», BP*3, ^fcS-^*, o$ 

[007 3] CCt?, ^fcf'JUarJMRSSKonrttWr 
[0 0 74] *7\rt/©Pft>, IP*3, ^^ZMP^rSBt 

*ff*«i««itt i-@f 5e©n#3W5c ft o fc 6 , -e ©ejstfs^ 

ZMP jffim i -SC-T S J; 5 K. 8UHffl<ci?f£ 
[0 07 6 ] HP*>, 139 (C^TiP< . ©ffiJg^-MJgSilSS 
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^-ftte«2#©ffl(citt&#±-r& (twelve r^fs©^ 

JSbSr^Tj (Cfa^) J:5&*7\>l/ZMP/"C£->U#>fln 
*.ttl>C i <!: 0, 2^f^C*f s ;l/^$IJW(C H^h, 
BP*., *f\rt/©»K* ^{i^f^ZM 

pccwmwk:— as* mcl/c 

[ 0 0 7 7 ] H 1 0 T-^^U 1 BA,-#,T?, *rf\»U 2 B 
xJk^fti or»4H 1 0 TSIWCinTct 5 KiSMT S Sftff 

£*-r cD^f r JU©?a@«i«^©S{c i) * ? h s 
10 ft£©-e, Haawswae 

[0 07 8] C©*i-£, *^«±K*>fcS*«fc 

ji'ZMP/^- >©*n«: J: -3 r ms-r n«&<, >„ 

[0 07 9] ±IB£WJ1£ ITI3 *#RSLTC©^ 

(c«S8«*»Mirr-5. ^ BHK:*Hr>rJtCJ:0±© 
§Pte©Ma«*£tT©J&#>, 1 ^Citefffrft, 

T©awa©«HH*w»jwnc:4 . ma 2 omsCiK 

[0 08 0] e©«»c*oTfc^{H*£R«fc, tl 

20 mp&om&vm&ztiz. mm&&t*> *?*4>ic 
if, Mii*^, ff±^fti\ —&<Dmm l tct&Qoym 

[0 08 1 ] ^tt, ^^^7 jt-ZtCk-o TfeiBS tl 

30 e>*ws3*i*. coBjifflWT mmji^s-z j 

ft€>IS«, rj^s^joBfr^Wft^^-xcMT-SA^y 
-^j *sw-r-s*>©iL/rf^ffl-r^ 0 

[0 082] ZMP^-m X, Y, Z)S^ 
«<taii»IBlT?Ss3tl* (01 3ft4(C7KT) . C©HJ 

itni*jj:o t iaffirttxffi«©**R"r43&s, yisko 

l»T4>R«-C*€>. i^, ZMP©Z^[6jBM^^5r^ 

swsiRHiraa*te*-»T(ri*<>©iL/, zmp©z* 
fiiiftifiaH^K: «fc -3-rasiWb-r *s4»ia:ai> *>© 
40 ^„ 

[0 0 8 3] MUr<9jt~*a* Si¥HlSt^ =7 * - * i 

*«3«-*^y-*, ±fti«§ (Z^[Sj©fii) *»SE 
7y-^J5:i**.«^ihS. 

[0 08 4] -g-n^Jca-^^, 8^SB|l9li^«(C 

50 is^-cfacxttimAmm. ^ga^s -3 18339^ 
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*s£Vmm¥-5 - 3 2 4 1 1 B-Jf&WfctfrMJRbfcS 
fBftffilVr, W£¥©ftg-^l£:teJ;Dlt{*©fig-& 

*Nij I*, imgXB£<b ©tragi*-***. 

[0085] agtt*ftt*jR:tt, 44B®W»«W{rd:<Z) 

fit (fwrftt) ©a»*a»or*»s. 1%. cc-c r*g 

[0 08 6] ^-^>lM4-Jg©*tfCDB#ra«ai^ 10 

©&»*.**?& *<*^a4B#^MMb-r&. IH0P 
»*.&fc£©f»«T'>. N. mSINKC^Ti. 

[0 08 7] *«ffijaye*8isBHa{c*jt»r a:. 

iiWS¥{iS©<»iES>S:^-r-5. CCT, & 20 
[0 08 8] *7Wifr^y-£&^(Cfcl=.Ttt5fc 

fc^as-^*® <t ^Bs^s©ra©±ftfeg • sk© 

^Rt*fc«*jRa>*. IK, ^©^ig&SM£jt«£¥&g 

^KDfig • its** v ^li^f^zMp^fti* 30 

[0 08 9] *5 s 4/$q&*9 -rf - s z 

MPIiiEMli. J^fliji 1 momwotgiK. 1 raygtt-s 

zMPmmMummkh^r 

JWC#^. 5 Z M P©^' $ - >-c*> so-c, c©9Jlffl*tr 
« r*f«juzMPj . J:0l¥L<« r^ZMP^? 

5„ ^T^mfo^^ * - £&5£S54, C©cfc5fCZMP 
MIES: ("rate r*f;l/RMZMP/-i7y-^j feftOU 
rtfJUfflZMPA^y-^j iijrT) fe^-TS. 40 
• s e^UZMP^9^-irtt. ^ff5©iS$i, tf;bZM 

<5o 

[0 09 0] *^Rfcl»l/LfflZMP*fci!»£S{cfa 
^ttt, -e©ZMPA^^-$fc^^ N ^t^UZMP 

(mm) *»ar*. 

[0 09 1 ] C©Slg(C:fot>T{4R<bL©2o©f?»frJ& 
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L (40 4 tCTj* i, fc@te*i^-M©^iijiJj^* ^;ut*> 
o > r * * -c A-etflss ( * 7 £ ;u©±f*<ag • iijg ) 

[0092] &<m&mmtctei l >x\ l z> m^^mscm 
&%arc^Lfe!&£jmfito*vwmm (©* 

©*n < «^#g>f 5 ^ - * **^-r s „ 
[0093] a^$R^K^stc«c»T«. 
^^Siir^L/fc^sMci^?, mm 

(*Wffl^ri©ffl) , JlAfifyCttffi^iffcftg 
ft. M^S^ZMP, ®^±#^ <g«Lhtti£g> *J 

[0094] *f3tifcs^±MiK«, mmmt}^ 

*=7)1<R, L%ftLXmg.$tl&*:? : MR, L©^&© 

Sftfcii^SiZMPKtt, -"ervl/R, LIZMPSf 
^^/rL/r^SSnS^^l-R, L©ZMP©ffi*t 

C0 09 5] B*±#fii|ft£tt3S5i^bWffl9!a{c»6 

fflJg(c*-3#, !^(C)SDTB«±^&g!&4**!ftiE3 
ft. <»iES«_hft&g • jlft miEsmzMP. BlEm 

[0096] mmMimwg&vmMm**^? a 
i> * mmgic m <o ft . ^ c -cA^naa* * v ^ ? 

H ©HafKH 1 K^-rj: 5 cc 1 2BI®f*>6»^5 

nri^©-c, i 2fl©H©tcoi>TW»fl}WMtt6i— 
nw(c^sn?, 0 ±iB©*!iswH2 tc^-r^ i ©?n@ 
^g 8 o ©wer* 9 , ftje§ titcmsm m^m 1 1* s 

[0097] c c-cnm<&mc-o\,>r(Dmw*mg.?z> 

ittlL, 1 0©^§(4^©J: 5KSa3n5q(t)i 
f CtO©Mt?ar J: 5 Cc Lfco 

act) : mwjzizm? zm$k (c©ra^fiiw, ^jticfc 
©<ag • kmb. ±#©{4g • ws¥©fig • m 
fct) : ZMPifiii£taai-r£iw& <c©w^©<iittMia 

©SP< V B^Jt(C*JW5ZMP©figCx, V ,z) 

[0 09 8 ] *fc^wi^{4M--7y-^*SiSiLrie# 
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AC t: a, b, c, d, x(k), y(k)) : S«b$ljt£fej$-r -S 
Wife 

f( t: a, b, c, d) : ZMPitflfclEifiTSHWR (JBfcR 

#&fai$Tr£iwgfc) 10 
ffiu 

b : tmmm&wm&M 

c : JtJW£8F*S©ZMP©X)S1§l 
d : #»£*#»§©ZMP©Y!llI 

xck) : imtmoxmusam 

vCK) : ±fiWOYO«93l9U 
[0 09 9 ] C©^IB-C«, B#^J&-«©^.*--* 

n«. nwaioftjBflf- ^*wt < r * 

T -5 * =y J - £ CD <£ 5 -o r l> 5. 

[oioo] co^wcwean-ett. tBiLhtttiai • 

ffc&g- 3SJS^7p<- ^{C— SULXK >£©T?, •f-CDIB 

Jfi4«w-r*. 30 
[oioi] ccDHte©?f^c*j^-rtt«*^<bL 

mo««*g 

q( t: aO, bO, cO, do, x0(k) , yOCk)) 
f( t: aO, bO, cO, dO) 

m 1 

qC t: al, bO, d, dl, xl(k), yl(k)) 

f( t: al, bO, cl, dl) 40 

qC t: aO, b2, c2, d2, x2(k), y2(k)) 
fC t: aO, b2, c2, d2) 

[0102] cnb&mm&<Dtmmmg.¥-titM • mm 
tfetsmm&w&s: • m 1 1 &t»uia 1 7 

PJE¥©ptf&:£fa£X$l SJ&^(S]4Yfii(ci€» 0 
[0103] CCXM1 SfcJr^Hl 9 icm? J; 5 



nmW- 10-217161 
16 

MfclWOttretBttll-rS. ft, ffijg 

ofij»awja¥rti* a 3 *<fcpgitt>^jim¥Mrffc 
{4gb3*^o 0 m*m&m&c*to. tmrnm-x- 

ti^fiwrnm^mz- scita^ xmtc 3 *i •?$#> 

[0104] 3*5, 7 ^ - a a ©ffi« 

a 3, b©itiib3t*S„ mm\t.. $$©&#&ttfc 
•f&'HC, -?-©ffe©A-5;<-£c, dfei^-^x 
Ck) ,v(k)4i0f5I(C^-rS^-C*>-So 

[0105] fCt, S$fi&$g& 
qC t: a3, b3, c3, d3, x3Ck), y3(K)) 
f( t: a3, b3, c3, d3) 

i*i* v ^y-£c3, dSfccfcO'Bf^Jf-^UxSCk), 
V3(k)*^-r^„ 

[0106] cct, mm*femtz>t. 

X 7- -f » 6 2 ft if ©jftfftC J; 5 ) * fc«BiJ©ilH#> 6 
[0 1 0 7 ] -e*iK:*fL. c, d*5J:[>'f- 

c tamibxmLtiXDx^ mmmT~-7)i>&m&&5£rt 
[0108] momm&®im<Dn 1 *jj;l>^2 

[0 109] CCT, gjjc^O.'^^y-^ (CCDBJjjffl 

S^) ©^sW^^-rsi, SeM^'^^"^c3, d3fc 
•tO'fiaS^p^Jf— ^;Wx3(k), y3Ck)«, t>r*l*>. ^ 

[oi io] ms5!p 4W5j^jamijrc*&tt6t*. 
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P(aO+ A a, bO+Ab) = P(aO, bO) +SP 
Sb~Ca=aO,b=bO) *Ab • • • ffifl^ 1 

SP / Sa~(a=aO,b=bO) : a=aO,b=bO -COOP ©a fCRIT 

SP / Sb~(a=aO,b=bO) : a=aO,b=bO f©P ©b ICffl? 

[0 111] JEK, 

SP I ^a~(a=aO,b=bO) = ( P(aO+ Aal, bO) - P(a 
0, bO) ) /Aal 

SP J 8 b~(a=aO,b=bO) = ( p(ao, bO+ Ab2) - P(a 
0, bO) ) /Ab2 

P(aO+ Aa, bO+Ab) = P(aO, hO) 
+ ( P(aO+ Aal, bO) - P(aO, bO) )/Aal*Aa 
+ ( P(aO, bO+ Ab2) - P(aO. bO) )/Ab2*Ab 
JE^2 

ceii2] zcDim-ftowmzm 

[0113] a3A5ali a 2©P^WfC*fttff»g£\ *f 

x— mum?* tut 1 ©-M»g»8 oo^^tra 

[0114] ^TCC^Jl^^^-^fei^'^T— f)V 

c3 = c0+ ( cl - cO ) * ( a3 - aO ) / ( al - aO )+ 
C c2 - cO ) * ( b3 - bO ) / ( b2 - bO ) 
d3 = d0+ C dl - dO ) * ( a3 - aO ) / ( al - aO )+ 
( d2 - dO ) * ( b3 - bO ) / ( b2 - bO ) 
x3(k) = xO(k)+ C xl(k) - xO(k) ) *( a3 - aO ) / 
C al - aO )+ ( x2(k) - xO(k) ) * ( b3 - bO ) / C b 
2 - bO ) 

V3(k) = yO(k)+ ( yl(k) - yO(k) ) * ( a3 - aO ) / 
( al - aO )+ ( V 2Ck) - yO(k) )*(b3-bO)/Cb 
2 - bO ) 

[0115] JJK>ate5SM: % &W£^<7J-Z*5&& 
c3 = ( l - ( a3 - aO ) / ( al - aO ) - ( b3 - bO 
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Sa~(a=aO,b=bO) *Aa + SP / 

) / C b2 - bO ) ) *c0+ ( a3 - aO ) / ( al - aO 
)*cl+ ( b3 - bO ) / ( b2 - bO )* c2 

c0tcl±c2<D<!m.<Dffl& 1 (C&r>Tl>S©r v 
c3(*, cOicli c2 ICttTZmfrtf-Ztl^ft 
Cl-(a3-a0)/(al-a0) - (b3-b0)/ 
( b2 - bO ) ) 
10 ( a3 - aO ) / ( al - aO ) 
C b3 - bO ) / ( b2 - bO ) 

[oii6] ±.m<D^mcj:-o-cm&t£&<D^7jt--z 

[0 117] ±.iZ*mmtbX:. J£TF. ®2 0 7P- • 

[0 1 18] Jfef, S 1 0(Ctel>Ttf-7 5-r>-C{1^k 
20 fc«rK«lfeWS©^-4t»*ROM8 4 (SfcttRAM 
7 4) (CfBtt^-tfS,, SX^VS 1 2iCit^, 4*©«*i 

*s©»«©±#tt« • a«**a>"ciaft-j-s. 
[oii9] 3£j$w©&g • $6»*— astKcatfc. a 
^©«i*^*]!)nsworf#iE.^-ss^^(c*j^ 
"CB. • »JBT?©_hfMMi • 2flt«, wm&&<Dt& 
^#fcfcws±#:feg • ilK©tt]«^(c— ©nrs. 

firl&aBtefHU M£^©i7J«:focfcO^©±#ftg 

30 • mm&<m-?z> a 

[ 0 1 2 0 ] «*.«. &ffi©±&fig • atttt3feK»t 
fcfcK. ±«c2 4©&g*SM^x(k),v(k) iLTf-^ 
;Mb3ftT(,>£©-c. ^iS&feg • iMfj*?— ^jko*» 
i-eoitHU©^!©^-^*^**?,, JWfrftfcttSfg 
©•#fBI©tt*»Mtt«£-r «f*i-€-©emf© 
B#2?J©ffi©«#£#&T»iffiigK its. 

[0121] s 1 4Ka6^«awtob^*f*;i- 

[0122] ttflMH7^?*®«W^*HR»K:fT-3 

40 r#aa o ©* f*innti*5(si-r ^ z m pmm^ 

£->*B|Jj®c:fc«>5fc«>K:, c©HSfe©^-c«a* 

14*^^-CH«iBROM8 4&SlH3:RAM7 4CCI2 

tt-rs. cwfcfewa^^^^zMPUiitf^- 

[0 12 3] BU^, H2 lfcj;0*ia2 2iC^-r*n< > 3d 

i *^fc<fc ^ 2 *fs^icfc(, >r ^e^u zmp # 

SO [0 1 24] @23)fe^Lll2 bK.7fct£>j< l Z, 
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**WH£ »£t V rSBtt! o r*5 < . c ft 6 t£ftj£©*n 

[01251 *-ril/ZMP«i3M^-^-> (0-e 

« rtf;l-ZMPj i^T) ttWE©in<-&j&r«*-> 

ic£~>xffif&2ti. -e©n#p.g@2#«. mi&®tm2& 
^©«ss (testis. fwt#s&£) «c 

J;o-rii5t3fts 0 s^t-'ju z m p $yt * - >«b# 
rags^JiW©^,* - * test u-c i ■otcvzm&.mt 10 
u -e-ft^*o<bufc„ 

[0126] Jlftiftictt, fftfiftH 1 (^e^i/) ©SBBtt 
Si«ra£Lf?±t«S8 (H|J*>, *f I U.SEfil=0) il. 

*z mp tuft * - >&c*hr &M&&?©«tt&£x» 
#&***?©#« • jis*«#-r^o wsashf-© 

[0127] CCDcfcOCt, SaUttWe^iWIU^Tft 

ZMPA*- >©*&£*§-£■£ UT^tCffS C 
[01281I207P- - ^ + - hCSS^CR-Si:. 

"C©X+ ? ^fi/tc i' ) Kf^ZMPAr^-ii & £"© 

SfltMt*fT5. 30 
[0 12 9] iWS 1 8.(Cji^$^vfl[t*0 4U 
(^-Yv^rX^-hS-lf) . S 2 0£gT S 2 2 tcjl 
*-f -7j|iJj&#4fSo <S 1 8<Dist-{-?tiXmtJ: 

*) . C ©«•)&#«* 4 vttWfctf. 20ms (Mffil 

JSM2 Oms) CTiKiBttSftS. 
[0130] S 2 2rjr^vtl»)ii*!W«BSftSiS 

1 ^©^§*S3£TU/c*>S^«»fr-S„ * t,TS5E§ ft 
*&*ttai&«CS3 2K»tf£ftK: > ttSSftSiSB 
S 2 6fca!/*/T?£-f v*0«cy-fev h U S2 8K^ 40 

t?x^i»©i?Wft**ff 5. jiftwictt. iria (h()©^ 

[0 1 3 1 3 fSj. mm<DWS.<Dtc&. 4H3d#W*R 
( L ) , -^HittWfcL (R) ft. fcflifc iiSL£ 
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r,xmmm cfttc*tu run a* 
)\s<Dmm*m c s t # ©ware* s„ 

[0132] iK^TS 3 0{C3t^*^«3#tof)ete 

[0133] m2 6«-e©Ma*^-r-9-^-^> • 7 

[0134] 6(T^T5i, 5fe-TS 1 0 OiCte^T* 
iWaP^^^JjR-r-Sfc*©, jg^-r£&ife#g©a8 

©. ^-rs^m*^©ia^>/-?-ia^©^{c± 

[0135] s i o 2 icm&i&tbtS?&fr. 
mm&ft&frmwii'. sj£3fts&*»atfeecs 1 o 

Sttjitft^C. 1f3£3ft.5££ttS 1 0 4«C«A/C^ 
(8f«fl»^*^;l/R (L) (CioT©*10 

©jasaKe^"55y-dKDs*«*«»ii*. s 1 o 

6 K^r^BA^S (P«Cc«tij!tti^^*^;UR 
(L) Ki-,tO»lSM8) 'feffRWSVt*©. n 

[0136] ^t^rs i o 8fciiA/c;fcig*#g: (^2$ 

©jt«^^-v^-^©g*ffi^M^ii«^, S 1 1 
0 tca^-C^ajB^*® (®2-ig^^) *fBST3fc 
*©, iB^S«W^S©jW?i 
[0137] C©i^. ^£ttffifc*stt£iBlft&¥& 

«csfrss*i*jisaurfc^». flu. ^©ft (ion 

r. t)MllWe^3cK#H«c« *>©3&iffl*3ftr t»s <c 
L-r-e©tfi*'6**>s*fli{cjfii»fe 
©^«^„ »^tcJ:orB*««:iKas«:— 

jWwwms*^* < -rn, ^©ftws^tt^w^ft 

ft-5,Jt»6T*So 

[0138] S 1 1 2 K^T?*f*^R ( L) © 

«iit^'7^-^ (fttWI) tZMP;^^-^4«St 
So mm<Dia<. -=&-r^R (L) * 
t^R (L) ^0^^ (miS^g) i^Sii 
t=r^ (^2iS^^) ©Wc©ii^#§©^jlM* 
JT^^-TJ;5{C^'r-5ift{C % ^;UR (L)IZM 
p^-^^-$« v ^-|5|^i^H^©ZMP«tjl3!»So 
^o^&^jUR (L) iW2i&8L BP*-. 

[0 1 3 9 3 H2 7 «*©fHt*n«'-y-^I/- ^> • 7 
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[0 1401 5tef S2 00tCtel>T, BUlBGfc^2^ 
S. «*.«. ^20^©SJ«}jSJ»fig*-5Ocn.i^ 

[0 14 1] m>X S 2 0 2 *^**R (L) © 

Dm^fUf^. (WT**.«. ■fcf^ZMP&t&SD 
s«10 cmifc-S. ) 

coi42] it,>rs 2 o 4(cja*. ^M^g (ui 

1 *Hl^g) ©*£4£±&ftg • jiJgi&IHili^g: (H 

rfr5. &m&?g(D&ffi{iLS • ilJK»5fc©S l 2-e*25 

J:oT»*©i*awfc*i8i4. 
[0143] s 2 o 6 fcjt^ mm ufc^-Esig^- 

[0144] »l»r S 2 0 8 Ki». ±ta^^«x 
m, Vm^+t^AtSfci!), -€-©il!$E- Xm, -V* 
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*m£. *?\>UR (L) ©tyt^;<-£©r*J©^:?\>l/© 
» :/*x s *jJ:o*-=e^;u©jas^^ y ^SV s 

[0145] ^TS2 1 OlcMfr, ±I2^(cflD^.. 
JEfc. ^2^,^r-e7 :r JW#ih-r-5J:^(c < 

mi ^<r>mwjk^h^xt0:mx<D^)v^mx c*sd 

s (BP-&. -Dm), *7\U/j£gVc#i0K:&5cfc5 
fC. *f\ll/R (L) ©ZMP^7^-^©tl#g 
ZMPi02^ZMP?:?li$lJ6<J^8!i§-t±SM (8MB 
10 Wl. SI2^ZMP-'nVTX) Bl. B2£&5eT 

1, H2^§ZMP>W7^B1, B2tti7(C^<^ 

[0146] ^-T. B 1 £B2£0&Ebfcg ISl 
fcfigx=f -» 7*ax s . ilKx* -y y'mv s fcj:^*^ 
^ZMP^S&MD s jIf3©¥S&£i*it££ v ^©*Sfr&* 

«»«f&t?* s c i *> h s ssmm* m$kx§m btct 

-ro-t^HSHiX c £®KV c tt, ^T?*J66tiS 0 
20 <X£,<DXxtj:£<D%&<DMm*. 12 1^112 
5 iCnk-TM") 
[0147] 



Xc=Xx* (-Xm) +Xv* (-Vm) +Xd* (-Dm) 
Vc = Vx* (-Xm) +Vv* (-Vm) + Vd* (-Dm) 



[ o 1 4 8 ] ±mmmic s mcm\&&zMP>nrx 

B 1 W^tti^2^ZMP^V7^B2W 

zmmz^m u tc t % tcm 2 ssmm-co* f^&Mx 

ctoDs (B[J%. 



SSI 



«Sl$gZMPAVTXB 1 if2#§ZMPAV7X 
B2©ffl?r^-rs„ 

[0149] ^©fcfe{c«. ^scft»jai/«:wti«ac6 



Dm) . mmv c&OlCtj;2 > J:5t l cmo 

Xx* (-Xm) +Xv* (-Vm) +Xd* (-Dm) +Xb 1 *B 1 + 
Xb2*B2 = -Dm 

Vx* (-Xm) + Vv* (-Vm) + Vd* (-Dm) + Vb 1 *B 1 + 
Vb2*B2=0 

. . . 5£2 

[0150] SCI i^2^6^^f#6n^ 0 

Xbl*Bl+Xb2*B2=-Xc-Dm 
Vb 1 *B 1 +Vb 2*B2=-Vc 



[0 1 5 1 ] BPfe, ^KCctO^^KagXcfcj;^ 40 
1. I2#§ZMP^-f7XBl, B2*3fc»*i«& 
[0152] i26K^5i, |l,>tS 1 1 

T&i^mic^mLtctf'^L (r) ©&«• as 

ljfttCCS 2 1 O-CvUffSn/c^^UL (R) ©fi 

a* * -j ymx a . aw:* * » ^sv s fc^ -> xm? 

Umcm&f&tgklC. ^rf^L (R) ©ZMPa'7^ 

-£kffifl^«nr£„ fsa, *t^l (R) 50 



. . . SC3 

KiiffflLrt^©-c, (R) tct-5tii^ 

[0153] Ml>tS 1 1 etcit^ *f\>UR (L) * 
JKSrOCc-rs,, cn«mia©An< . M#g^5Rai55±© 

[0154] iuts 1 1 &icm&. mw.ztitcwm# 

— *^Hff©^^J«)#*3«)S{CS l l 0-C*«)6ti 
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©-?&£„ 

[0155] m>X S 1 2 0tCMASC- £ mm&&gr<7 
[0156] IfttvC. S 1 2 2 {CitArWHtS^^fi 

k» ^mm^^ommmm&.& (jEm^mm^nm io 
fccitcA-crzMP cDWKi&g^Wo & 3 # ;=> -r 

^ Z M P fem&lC £ o r^ittltflRjH 3 ft £ „ 
[0157] i20KI§i 1 il>tS3 2(CjtA/Til 

£*#s©w$f8 (MiiiiTioi, mnMin : o * 

£M?Z> (S2 4"C5je3ft*i*4l§I«r*S) . 

[ 0 1 5 8 ] B2 8 »^<Df^H*/^-rif • 7 

D- • ^ + - h"C*&. 20 

[0159] OTMB^^€»i, 5fe"TS 3 OOttUtjg 

•^^•c^ ^ -incm^xmrn t fc*jtf sig-^gfRz 

MP4*S>, S 3 0 ZdC&AsVW&t&^^jt-ZteJ: 

vmm0mcg'3^'cmmmm&ffizm^xmm t r© 

ZI-^JE^lug • &#&3|i«>. S 3 0 4 icjt A,-eB#SiJ t f 
fi&fi^Wig • m%t t - A t ©±tt*¥tfH6&» 6 
B|Mtt?©±#SI3^S)^ 0 Cftt*«jl« % *MA 
rt«H«PP8 - 2 1 4 2 6 0fCML,/«il,^ o 
[0160] *H,»r S 3 0 6 (CM*, aftLfcMttgftgF 

[0161] 02 0icg|££, SH>T S 3 4 tcit/^Tjg 

[0162] C(Oft»*»Wr*i. -trf^R (L) JS 
ZMP^7^-$ , |t 1 $StC*JW ■5*7-*^ Z 
MPISNFffiiffffiLtr^^R (L) ©ZMPPJBfffli 
-TS. ||k>T«9*JUL (R) mZMP'<5j*~5tKX-3 40 
^2^{C*jW*-=&f I ;l/ZMPSB#ffl*IWJ0r* 

t^l (R) ©zMPwstfi-ra. {au m2#mc 

[0163] «l»T S 3 6 fcjft*, 3SS&«fr#3Mr7VU 
R, LtC±£T*J&fc^fJPfflZMPI3lW!?:AAt 
§C iCCio XWmti^fto R , L ©^f&£f tl¥f 

5. Kc. 03{c^-f£o<, tf;i-R, L£/?-Lr?f!#f 

IfctfJl-ZMP^Mtttf^ZMP©^^ 50 
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£&«:. *7*>IR, L©^{4 (±*©{£g) ^JJD»U-C 

[0164] «t»r S 3 8 k:«At^£#^£Sf»)SWj 
^fOi/R, Lfc^sWa. BPfe. El 3 (cijrrftK . ?S 

ei±<«4g • jie<b -r •& £ ftjc , mw. vtc^to zmp 

fn£*i^s*§ Z M p icmw L X @« Z M P £ t £ . 

to) ©ZMP*jlR:*<[3ftTl>*. g£ 
oT, 3 ft £ft**flfj& B&^© ZMP f;j 
JQBtt »JB¥ffl«©^»a«M 3 titc $> © £ ft «3 . 

[oi66]it,»rs4o icm&xmn t £ A t tcvm 

[oi67] ±fB©*o< uria3 K^-rso< . g*i±f* 
fig, mn±mm (m-s±.&mm) , s«£S¥{£g • 
%m m^^itm • mm) ^^zmp^s 
ft, mm<Dim< , «^^b*uai^g(c*ji^-r^s^* 

ii^^v^ ^ zxmn.mxmBftm&m&mg.2ti&o 
[0168] c<Dmm<D&m*±iE<Dim<mmi,fc<D 

[0 169] iOffKtt, *«-^Jliafttco(,>r©ffi 
S©»fctc*f b riBttf 3 ftfc^o*>©«i|l^*> 6^- 

x £ ^ s (c jgg? u . ^»s4»s»ft^©iB^a 

fc^^ff -^^{C HATS S^^j^ST S ififK*^* U 
7J^>fA CC^fiST scims. 
[0170] MK:tt±iB©*n<1f)jSb/cc:i^6, »J> 

ss*sjfiwft«) 8B?©aw8i&«0i±*<a»#t>*'ra^ 
-rsci(cj;«), -efte.©twai«ft*s*tt«K:*js-r 

[0171] sfc, ±ia©*p<^u/cci-r?i^cs* 

■i-r^Z>X%:M< <DK.lfr<Xm 1 ©S»^g8 0 ©?n# 

*wi/i oggicfi^-rSo hcc. *&&«iti$g& 
fBtf.L-r*j#, ■eft6%®^L-r^*^-r-s©r, 
^*>; (ROM8 4) (D^mbimz-ttzcttfixs 
*. M(c «aitt*»S"r*©-c. ifti)M5)4 

«jers#g*. KfT«MR*K^"tc. g^ic^^,c<b5&5 
[0 1 7 21 130 &Z<DmiiC&t&&m<0962<Dfiim 
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1 o 1 7 3 ] m i <Dmm<Dmmim^mmcis^xit. 

<Dm-£> *f%>p zMPiai i$m<iymMfo ^n^m^ 
u 2 *&§©***>*) mm) x-mfflv^v h (m.-±L& 

it) 3-&6tl^„ *?vbZMP2«2^a©<fJj£#>5^ 
fT&MfclfU 3^0^*30 (Ktt) T?Siawy-fe» h (it 

fi^jt) s-tf-en, ^t^uzmp 3U3&m<Dtpmfrh io 

[0174] e©«fc5CeS^©SaiKD»«Ne*«,»Tt>^ 

<t or «0 3 i rmcm-rj: *> ic&m-r s^, 
i'?©zMP*f;KJ2#c:i{c>;-b? hsn-s,, -e© 

[0175] jy_t©£q< . i & £&m2 <Dfm<mm 
jcjaor a:. 4>&< 4&«# (±#) 244, suiaaf* 

(CKgHO. 12, 1 4R (L) *ft\s-cm&Zti2>m. 20 
ifcfc©«SP U > f 2 £ fe^BS^ftB #'^M ©*£ 

4<D^feteJ:c>V*)t«jSatcwr-5^ - 7^-^ (±# 

<ig-ii&) i^psKf tt,cmmmwfy%r?m-rzm 

KMcmr^^^-^t (ZMP) 4^e>£r3 ia*:»© 
*«*i!>«c < 4 6 2 « (W 1 <t CFNI 2 $8 $ fctt 

^ete&8*i«fco f ;fcH#«o £jjR-rs*Ng£i£*ia 03 

cHSES. 020713- ■ ft- |>©S 10, S30. S 

3 2), ffin&mz ntc&tj: < t $> i mo&mvmmc 30 

B^^fcO^TCffl&SXm, Vm, Dm£#ttJ-r S^il 

2 07D- • ^f- KDS 3 0, 0267n-^t- 
hOSl 12. 0277n--f+-h©S2O 0#>«E> 

s 2 o 6 ) . m^m , ixf}(Dmmc^-r^m^m^(D^.&. 

(m3<DimWlJl¥*:7 s >l'R. L c 02070- 
• ?t-F©S36, 02 67a--?t-f-©Sl 1 

4) . mmn.m$titc*mMm.icm^x , wm^)v 40 

JU^CDA^JB 1 . B 2 SStjeTS^e^A^Wje*® 

f-p-KDSSO, i267D--ft-h©Sl 1 
2, 1277P-- ^t-h©S208*6S2 1 

o) . mfie^^ti/cATjica-^c^BMfa^^KDWTj 

(*^JUR, LZMP, ^Jl<R, LTOI) ZWtU-f 
S*^tU*«tW*R (H3CD*^R, LfZMPS 

a2 07O-'ft-h©S3 0, S34, 
S 3 6, M2 6 7ta- • KDS 1 1 4, S 1 1 50 
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6) . fcJ:^t«fa^2n/cA73fccfcD f f>iia^Hi§n/c 
^■futojiicmn » x mm'ptz < 4 & 2 m<D&&<F>'pt£ 
< t M>-rn#»&fl*jE"f je^is (0207a- 

• * + - KDS 3 8) £ffiZ.6i.n<ffil8,Ltc„ CtitCj: 
or. 1 #4 1 i 4 ©iai©^©^^£j>& 

m R , L © 2 ffl ) «*. 5 4 ft tc . iwi SNUfflD*?* 

[0177] *yt. ffria^e^u (sawMj^^m. 

[0178] Sfc, S6«C. WK*^fc*fU**»0& 
* A77 b fc 4 * ©* ^^^^©^Stl^tt ( #K HS<4g 

• f + - h©S 1 4„ ROM8 4, RAM7 4) 

x., anE^f^A^sae^stt. Miatati^tifcPKi!^ 
t±(ca-2t(,»rt(ria^f r ji/A**»mt-s*p< KWSUfc. 
*n«c «fc or, ±ia l/fcfPMS»*KJDitr»JW*— Ji 

IB»-r4C£#i-C*S. 

[0 17 9] sfc, Hffia-t'?^ (mmmti^^^R, 
D *m^-K,«(c*it^ri:s:ff±-rsj: J 5K:^$n5 

^o^fiJWJcm^f-j tiff 1 
— «aHjj(c*RSf * C 4*sr^^ 0 
[0180] s/c, fria^e^mj^^iiiaj^JKTj (^e^* 

(4fn) r*^>ip<«jsb/c 0 ^-nicior, ^s«l?r 

©a^t4€:« o-oosffl{css%*»^« o xmmm 

r* **S*-na«j{csjiW* c 4*3r « 
[0181]^, ^l*jJ:^ll2©5l)5S©Jf^{c*j^ 
r, 01 0*5*0*03 KC^-TfrK, mmkft*2i£<D 
IB-casilS*s«fc5«:Lfc*t. C*i(c|ig6;h.&fc©rw: 

^w^fr* 3 *feLh©fara^^# r &&t,\ # 
pffi^««BK©i*s) r$^w ; &vte.*Hc-r^c4^ 

3-a-sc4fcj;or2 mA±.<D&mt<mm-%fr 
s-ttsi^jcur^in,*. 

[0 18 2]**:, «IWtt^6*9 I ;U«2*«:£{C»fl 
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i<tm , &<Dg!m*tz>&>jicvc§>m<K kick, wsm 

[0 1 8 3 ] *fc, 8f«Wft^e*^*2fl**l>tt3 

c ntcRg e>ft& &©-?«&< , na*si> 
« 4 fflW±t?<fc -o x h mi >. 

[0184] *fc. -t^JKOttJg (Ifljl) tt. f-^U 

fiu ^ji/«^fiai©fi£^/jN3!is-e*%t,»© 

C 0 1 8 5 ] *#®^©^li L-C5fe©Ui^©» 1 

<DmM<D^m^m^tc^ ^<Dm<D^&oMWix$> x 
mc tm* (omwmtx& s . *m%m& l & < x & 
[0 18 6] ttc, iiatcfc^r. $^5y-^tt/ 

J^0S3*i5C£tt3$*rt>&l>. fib, flaws* z 

mp t±#<D-rH!tcthmbtcmtrj:6(Dx, mm&jiai* 

[0187]Jfc, C©»W*2ffi*fTnsK v HCMU 
[0188] 

imivfm] mmimicmm-rzmitciib^xiz, 

1 *i 1 #£©W©^©&!5^f££»6*>fCjgj&3 30 

[0189] m^j2^tcf2*8-rs^wc*- 3 r{±iiia 
se^iwtirwiaw jeoittt^^-r J: 5 teases ti&bu 

bftxz&i&^mtytc^j&t&ctttx* 

•So 40 
[0190] 111*53 W(c8Btt-rS»W{C*-9rt*iRE 
tf^wfBo #f 9 h ^gteJl^-cififH-r san < fas L/ 

[0191] ft*II4WCfetg-rS^K*- 3 TK, s 

^»*»riaBr«-siE«^a**jt, HE****** 
K.mx.xm*mz-m{8m-rzcti!fix*z. so 
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[0192] m$<Mbmc$>-oxiz. m&^rfr&m-? 
m7£<Dmm&m.3L&±xiSb sap < mm utccox, mnm. 
mr©aa*tt*«5 -o-o^mc^temmzm-y xmi 

[0193] HtfeatC^otB, MIB*? s rt'UWj#< 

wmi*.&j)*s £ ^«rfaaf*©^f4f* sap < mm l/c© 

[01] C©#6^{C^^JW^«iOjK^ h 

g&£#imt*-rt&Bj30-?& s . 

[ 0 2 ] 0 1 (c^-T 2 HiH? P tf' 9 h ©^j®;*- 9 h © 

t^M^-r^p 9 i^-c&s. 

[03] eoaHeffi&Jteg&lbatf? h©#S£«8t 
§©*#)$&.£ ^WP&tmW^-r^P 9 i70-ca5S„ 

[04] 03Sig-c^ffl-rs@js:iKF- ; ef ; ju4m-ri^Bj 
0-e*s o 

[05] 2 -oo^go^Jcfci^r^a^^ab-S i *© 
?*~hx&& a 

[06] mstmmtemwZ'fzyy- r+-hx$> 
s„ 

[0 7 ] 2 0(D^©%ISt{C*JWS^aEg6*+ * >^ 
-r&tcubO^&Z J: tHKHtlji -f 5 >^ • ? 

[08] 0 3ggrf i^iitt^ftfjKof »©S 

[0 9] H3*6a©2ffl©SaMft^*9»;U*«it4« 

[010] 09©«^{C»^i-C^L-/c^7 : -"Jl'©^Sb 

[011] 03j|gr^fflr-5«?»*§©4i©mo«5* 
^©jfi*Hfics*iJ: o'^^^-r^0-e* -So 
[0 1 2 ] 0 1 1 ©aro«!ft&g©fi3|ztt»*^-r* -r 
3>f • h-c*s„ 

[01 3] 01 ioso»§<dzmp (xmm) © 
[014] m3mmxmm-?zmm£^<Dtp<Dmimm 

[01 5] 01 4©Sll«l»g©ZMP (XffiSI) © 
[016] 03«gT^-r^S*i^^©cp©ll2^i« 

^©W{4g*J J: of^i^-rawRH-c* s. 

[01 7] 01 6(Dl2iW§©ZMP (XffiW) © 
*-f 3>^~ • ^ + - F"C$)^ 0 

[018] 03»g©#^is«&{ / p-es*sn/cs*^ 
^©Wffigfc =fc o t «»*wf«MBH'r * S „ 
[0 1 9 ] 01 8©S**S©ZMP (XJffiS) ©£-Y 



29 



[02 0] m3m&<DW}ftZm-?7U~- 

So 

[02 2] 02 07a- • * + -h©*oiH»WlsSwa 
f#sns^2^ ckhms) ©zmp^s&m (avt 

[02 3 ] 02 07P- • b<Dtmsmfmvm 

[02 4] 02O7P-- hO^a&ftftrjii 

[02 5] 02O7H-- ?r~h©*M3tftfl3lt?& 
^•Ti»W0t?*s„ 

[026] 02O7n--^t- h©2t*&#J 

So" 

[S27] I267P--ft- h©<£©-=&-7\>i<«ijt;-c 
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^r-h-Cft * [02 8 ] 02 0 7 P- h©4>©M-£#^©B?t 
[029 ] 02 07U- • ? + - h©t$i(D*f\;!/ZMP 

[030] c (omm<om 2 ommmm<<m^mm.<Dm 



10 



20 



[03 1 ] 03 0 ©MtClo-i^^^t/c^f Jl'Of 



1 
2 

10, 12. 1 4R. L 

1 6 R, L 

18. 2 OR, L 
22R, L 

2 4 
2 6 
44 
7 4 
84 



±» («*) 

RAM 
ROM 



1 ] 



[02] 



I 



Mm:' 




/ 

J . v 


) 1 

! 




! ' - 











I 




"1 




22L 



SI©**** 



ROM 



RAM 



54 



.74 



A/D 



,86 



D/A 
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[03] 



c 



T 



T 



i L 



*±*ttK ■ BK 




ZMP 



F 



^t^ULJB ZMP 



3 



ZMP 



1*- 



mm 



■^■r/uzMPfq 



ZMP 



S^ZMP 



(l«LhfMSl»). 



{ftiEB«±-|ttJEB«l 



f - 



CIS) 



mmw- io~2i7i6i 





SfHf$*l|* ZMP 
A I 

! 

\J 



JbttffcH 



A , 








L 1 













n + 1 



[Ell] 



!2%%l_Jo w<fc , awe-* 



□ 



r3 



X(S&) 



[18] 





2*B 


3*S 


4#B 




\ / 

cast) T 


















ran fi 


mi 


I 



[09] 



ZMP1 




P 








ZMP1 






+ 


d(v1)/<ft = 
d(x1)/dt = 


k * 
vl 




-ZMP1 ) 


ZHP2 




P 




x2 




J 

2NP2 








d(v2)/dt a 
d(x2)/dt - 


k » 

v2 


( x2 


-ZMP2 ) 
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12] 




km m i #«§) 




(«1»«Ji) 1 



=Ef/l/ZMP 



SI 1 ^ZMP/W^^B 1 



i*» (S2*§ffl) 



[016] 



b2 



-Y (&> 



a=a0 \ 



HSit 



Xs(=-Xm) > 
Vs(«-Vn> 
^ Ds<=-Dm) J 



CHI 3 ] 



y 



mm 

t1t2 



t4 

4 — ?L 

f mm 



dO 



[014] 



•Mil 



bO 



□ 

— -x<*> 



man* 



[015] 



Y 



tl t2 



dl 

JL 
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10] 



17] 



it. 



WJU 1 t- 

W*2 f- 



WJfcZMP 



2*B 




4#g 



2£B 



A 



4*g 



m 



3#a 



mm 




[2 1 ] 




imttllU : X b 1 , v b 1 



mi 8] 



[HI 9] 



Y(*E> 



m% 



□ 



* ten c3 



| t t t2 



t4 



j t3 /| 



J 3a 



[022] 



[024] 



1 KUttlBBK: Xb2. Vb2 *»***tt »ffi*S©-fft 

\ 



j r-p^ 



RSI 



3B2*g 
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120] 



( START ) 



r S 1 0 

S 1 2 
S 1 4 



rS I 8 



t = 0 



S 2 0 



S 2 2 



r S 2 4 



i =0 



S 2 6 



r S 2 8 



U ijHia<L&&^|Hltt R) 



f S3Q 



r S 3 4 



rS36 



-S 3 8 



t = t +A t 



r.s 4 o 



C END ) 



(22) ftPOT 10-217161 



123] 



125 ] 



X — —i — ^- i + ^ - '^T' «*« 



¥tt«K©Tft. 



£1*8 



$2*8 



[027] 

C ENTRY ^ ) ^0:£J#JiO£R(L)fcT-5, 



S 2 0 0 



s 2 o 2 



D sCZ- D m « ft A T S 



S 2 0 4 



-S 2 0 6 



S 2 0 8 



3c » fcfKD 32551® - Xm, - Vn £ * FJU R ( L > OflfciS/ ? 5 X - * W CD 



S 2 1 0 



( RETURN ]] ) 
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126] 



( ENTRY ~} ^®l&;ni!H1tR{L)i:rs< 



r S 1 0 0 



f S 1 0 2 




r S 1 0 8 



SI 04 



■ r S 1 0 6 



s 1 1 o 



S 1 1 2 



^Et-Mu r ( l )«UW? * - # £: ^■fJU R ( L ) 



SI 1 4 



^?*L(R)HZMP/«?/-*6MHlEfkT 5 



S 1 1 6 



- S 1 1 8 



- S 1 2 0 



S 1 2 2 



^na-^s w^^js^iaii zmzmaz 



( RETURN ") 
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128] 



( entry) 



S30 0 



S302 



S 3 0 4 



S 3 0 6 



stars 



( RETURlT) 




^ZMP 2 



, ZHP1 

d(v1)/dt = fc * < xl - ZUPf ) 
d(x1 )/dt « vl 



are ; 



x2 



d(v2)/dt - k * ( x2 - ZNP2 ) 
d(x2)/dt = v2 



ZMP3 



set* 



ZHP3 



x3 



d(v3)/dt = k * ( x3 - »3 ) 
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